#pragma once
#include "gcode/gcode_cmd.h"

typedef enum{
    InitialState = 0,
    SearchDownward,
    SearchTop,
    RunState,
    MotorSleep,
    HandSearchDownward,
    PosCheckStateNum,
}PosCheckState_t;

typedef struct{
    PosCheckState_t PosCheckState;
    MotorAxis_t Axis;
}PosHandCmd_t;

#define TrayTravel                 (61.2)

void PosSensor_task(void *pvParameters) ;
double getZeroPos(MotorAxis_t Axis);
double getMotorPos(MotorAxis_t Axis);